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Die folgenden Angaben sind den vom Anmelder eingereichten Unterlagen entnommen 

Prufungsantrag gem. § 44 PatG ist gestellt 

® Verfahren zum Erfassen und Kompensieren von kinematischen Veranderungen elnes Roboters 

(57) Die vorliegnde Erfindung schafft ein Verfahren zum Er- 
fassen und Kompensieren von kinematischen Verande- 
rungen eines Roboters (10) aufgrund interner und/oder 
externer Einflusse mit den Schritten: Bereitstellen eines 
Robotermodells in Form eines technischen Algorithmus 
mit einem oder mehreren festgelegten Paramtern, wel- 
che dietheoretische raumliche Stellung des Roboters (10) 
in Abhangigkeit von einer oder mehreren SteuergrolSen 
beschreibt; Steuern der theoretischen raumlichen Soil- 
stellung des Roboters mit einer Robotersteuerung (100) 
gemaft dem Robotermodell; Erfassen der tatsachlichen 
raumlichen Iststellung des Roboters (10) im Betrieb durch 
eine Sensoreinrichtung (K 1# K 2 ; 50); Erfassen der kinema- 
tischen Veranderungen anhand der Abweichung der er- 
fafcten tatsachlichen raumlichen Iststellung des Roboters 
■ (10) von der theoretischen raumlichen Sollstellung des 
9 Roboters (10); Anpassen des oder der Parameter des Ro- 
botermodells zum Kompensieren der kinematischen Ver- 
anderungen unter Berucksichtigung der erfafcten Abwei- 
chung; und Steuern der theoretischen raumlichen Soll- 
stellung des Roboters mit der Robotersteuerung (100) ge- 
mafc dem Robotermodell mit dem oder den angepaSten 
Parametern. 
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Beschreibung 

Die vorlicgcnde Erfindung bctrifftein Vcrfahrcn zum Erfassen unci Kompensieren von kinenialischcn Veranderungen 
eines Roboters aufgrund interner und/oder extemer Einflusse. 
5 Solche kinematischen Veranderungen beeinflussen insbesondere die Positionierbarkeit des Roboters und riihren von 
internen EinfluBfaktoren, wie z. B. Alterung, VerschleiB, Derformation, . . ., und externen Faktoren, wie z. B. Tempera- 
Lur, Druck, Lastwcchscl, . . her. 

Obwohl auf beliebige Roboter anwendbar, werden die vorliegende Erfindung sowie die lhr zugrundeliegende Proble- 
matik in bezug auf einen Industrieroboter zur Vermessung von Falirzeug-Karosserieteilen erlautert. 
to Allgemein koininen fur die Vennessung von Bauteilen, insbesondere Fahrzeug-Karosserieteilen in der Automobilin- 
dustrie, zunehmend Industrieroboter zum Einsatz. Diese Roboter sind mit. einem beispielsweise optischen MeBsystem 
ausgestattet und konnen sehr flexibel fur komplizierte MeBaufgaben, insbesondere an schwer zuganglichen Stellen ein- 
gesetzt werden. Fur eine gleichbleibend gute Qualitat solcher Messungen ist es erforderlich, daB die kinematischen Ver- 
anderungen des Roboters keinen oder nur einen verse hwindend geringen EinfluB auf die Messungen haben. 
15 Der Idealzustand ware, wenn sowohl innere Effekte, wie z. B. Abnutzungserscheinungen, als auch auBere Effekte, wie 
z. B. Temperaturschwankungen der MeBumgebung, kompensierbar waren. 

Dies ist jedoch bei den heutzutage bekannten Systemen nicht moglich. Vielmehr ist man darauf angewiesen, die Ab- 
nutzungserscheinungen, Temperatureinflusse usw. direkt zu erfassen und zu kompensieren. Beispielsweise sind somit 
eine haufige Nachjustage der Mechanik des Roboters und eine Klimatisierung der MeBumgebung notwendig. Diese \br- 
20 gehensweise ist Zeit- und kostenaufwendig. 

Die DE 196 16 276 Al beschreibt ein Verfahren und eine Vorrichtung zum Vermessen und Kahbneren eines mehrach- 
sigen Industrieroboters mit einer Vermessungseinrichtung, welche aus einem MaBkorper und einer MeBvorrichtung be- 
steht. Der MaBkorper und der Roboter haben einen gemeinsamen Bezugsort, an dem sie losbar und austauschbar ange- 
ordnet sind. An diesem Bezugsort wird zunachst der MaBkorper vermessen, anschlieBend gegen den Roboter ausge- 
25 tauscht und an der Roboterhand befestigt. Der Roboter wird in eine Grundposition mit angenommener Nullstellung sei- 
ner Achsen bewegt, dort vermessen und anschlieBend in eine vorgegebene MeBposition gefahren, in der der MaBkorper 
erneut vermessen wird. AnschlieBend werden die Istlage des MaBkorpers in der MeBposition und seine Soilage vergli- 
chen, wobei aus den Lageabweichungen die Stellungsdifferenzen zwischen angenommener und tatsachlicher Nullstel- 
lung des Roboters ermittelt werden. Unter Beriicksichtigung der Stellungsdifferenzen wird dann der Roboter in die tat- 
30 sachliche Nullstellung gefahren und mit seinen Achsen dort kalibriert 

Bei diesem bekannten Verfahren wird jedoch nur einmalig die tatsachliche Nullstellung ermittelt, ohne daB die Ein- 
flusse von kinematischen Veranderungen des betrefTenden Roboters oder seiner Umgebung auf die zugehorige Roboter- 
steuerung beriicksichtigt werden. 

Eine Aufgabe der vorliegenden Erfindung besteht darin, ein verbessertes Verfahren zur Kompensation der Einflusse 
35 von kinematischen Veranderungen eines Roboters oder seiner Umgebung auf eine zugehorige Robotersteuerung zu 
schafTen, welches solche ungewunschten Einflusse erfassen und kompensieren kann. 

ErfindungsgemaB wird diese Aufgabe durch das in Anspruch 1 angegebene Verfahren gelost. 

Das erfindungsgemaBe Verfahren weist gegenuber den bekannten Losungsansatzen den Vorteil auf, daB es eine robu- 
ste Methode zur Erfassung und Kompensation von kinematischen Veranderungen liefert, die unabhangig von den Ursa- 
40 chen der Veranderungen arbeitet. Durch das beschriebene Verfahren wird der Roboter in die Lage versetzt, wahrend sei- 
ner gesamten Lebensdauer in seiner realen Arbeitsumgebung - in einem definierten Arbeitsraum - seine physisch vor- 
gegebene wiederholgenauigkeit zu bewahren. Auftretende Fehlereinfliisse werden durch das erfindungsgemaBe \ferfah- 
ren systematisch erfaBt und permanent kompensiert. 

Damit ergeben sich uberall dort neue Einsatzgebiete des Roboters, wo bisher aufgrund externer oder interner Einflusse 
45 die erforderliche langzeitige Positioniergenauigkeit nicht erreicht werden konnte. 

Die der vorliegenden Erfindung zugrundeliegende Idee besteht darin, daB der Roboter bzw. Posen des Roboters lm ge- 
samten Arbeitsraum vermessen werden. Die Posen werden abhangig von der Aufgabenstellung durch einen technischen 
Algorithmus optimiert beschrieben. Jeder oder bestimmten vorgegebenen Posen (Sollwert) wird beim Betrieb ein Istwert 
zugeordnet. Diese Parchen von Soll/Istdaten dienen als Input fur eine Prozedur zur Parameteranpassung bzw -optimie- 
50 rung. Durch die Parameteroptimierung werden die kinematischen Veranderungen kompensiert. 

Die Ergebnisse konnen dauerhaft oder temporar in der Robotersteuerung abgelegt werden, und bei Bedarf konnen die 
erforderlichen Anpassungen untemommen werden. So werden auftretende reale Abweichungen funktional kompensiert 
und das Positioniervermogen trotz sich andernder Randbedingungen bzw. trotz zunehmendem VerschleiB erhalten. 
Die Erfassung der Abweichungen und deren Kompensation im Betrieb heiBt entweder im Realbetrieb oder im Simu- 
55 lationsbetrieb oder bei beiden. 

In den Unteranspriichen finden sich vorteilhafte Weiterbildungen und Verbesserungen des in Anspruch 1 angegebenen 

Verfahrens. 

GemaB einer bevorzugten Weiterbildung erfolgt das Anpassen des oder der Parameter des Robotermodells zur Kom- 
pensation der kinematischen Veranderungen unter Berucksichtigung der erfaBten Abweichung, wenn die erfaBte Abwei- 
60 chung einen vorbestimmten Wert uberschreitet. Dies ist jedoch nicht die einzige Moglichkeit, vielmehr konnen z. B. 
auch Trends verfolgt werden und erst nach mehreren Uberschreitungen Anpassungen eingeleitet werden. 

GemaB einer weiteren bevorzugten Weiterbildung erfolgt das Bereitstellen eines Robotermodells in Form eines tech- 
nischen Algorithmus mit einem oder mehreren festgelegten Parametern durch Anbringen eines MaBkorpers an der Ro- 
boterhand; Erfassen der tatsachlichen raumlichen Iststellung des MaBkorpers durch die Scnsoreinrichtung an einer Viel- 
65 zahl von durch den einen oder die mehreren SteuergroBen bestimmten Referenzpunkten und durch Festlegen des oder der 
Parameter derart, daB das Robotermodell die raumliche Stellung des Roboters an den Referenzpunkten in Abhangigkeit 
von der oder den SteuergroBen mit einer bestimmten Genauigkeit beschreibt. 

GemaB einer weiteren bevorzugten Weiterbildung wird als die Sensoreinrichtung mindestens eine Kamera verwendet, 
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welche extern aufgesteilt ist. 

GemaB einer weiteren bevorzugten Weiterbildung wird als die Sensoreinrichtung mindestens ein Lageerfassungssen- 
sor vcrwendet wird, welcher an der Robotcrhand angebracht ist. 

GemaB einer weiteren bevorzugten Weiterbildung wird das Erfassen der kinematischen Veranderungen anhand der 
Abweichung der erfaBten tatsachlichen raumlichen Iststellung des Roboters von der theoretischen raumlichen Sollstel- 5 
lung des Roboters an den Referenzpunkten durchgefuhrt, indem ein jeweiliger Korrekturvektoren zwischen der erfaBten 
tatsachlichen raumlichen Iststellung des Roboters und dcm cntsprcchenden Refercnzpunkt cingcfuhrt wird. 

GemaB einer weiteren bevorzugten Weiterbildung wird die tatsachlichen raumliche Iststellung des Roboters im Be- 
trieb durch die Sensoreinrichtung mittels eines am Roboter angebrachten MaBkorpers ermittelt wird. Durch die MaBkor- 
pervermessung wcrden die Basis und das Tool unabhangig von der eigenen Kincmatik des Roboters geschatzt, und somit 10 
gehen auch seine Fehler nicht in die Schatzung ein. 

GemaB einer weiteren bevorzugten Weiterbildung wird die Gute der im Betrieb durch die Sensoreinrichtung erfaBten 
tatsachlichen raumlichen Iststellung des Roboters ermittelt wird und das Anpassen davon abhangig gemacht wird. Somit 
gehen als Import fur die Parameteranpassung nur gultige bzw. zuverlassig ermittelte Daten ein, und AusreiBer sind eli- 
minierbar. 15 

GemaB einer weiteren bevorzugten Weiterbildung erfolgt das Ermitteln der Gute durch Bereitstellen eines MaBkorpers 
mit Markern am Roboter; Festlegen eines inneren Koordinatensy stems auf dem MaBkorper und der entsprechenden Ko- 
ordinaten der Marker; Erfassen der Koordinaten der Marker im Weltkoordinatensystem durch die Sensoreinrichtung; op- 
tirniertes Abbilden der Koordinaten der Marker im inneren Koordinatensystems auf die Koordinaten der Marker im 
Weltkoordinatensystem und durch Ermitteln der Gute anhand des mittleren Fehlers der Abbildung. Diese Nfcrgehens- 20 
weise liefert eine qualitative Aussage iiber die Giite der MeBdaten. 

Ausfuhrungsbeispiele der Erfindung sind in den Zeichnungen dargestellt und in der nachfolgenden Beschreibung na- 
her erlautert. 

Es zeigen: 

Fig. 1 eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer ersten Ausfuhrungsform des 25 
erfindungsgemaBen Verfahrens; 

Fig. 2 eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer zweiten Ausfuhrungsform 
des erfindungsgemaBen Verfahrens; und 

Fig. 3 eine Darstellung der Haufigkeit von MeBabweichungen beim ub lichen Verfahren im Vergleich zur zweiten Aus- 
fuhrungsform des erfindungsgemaBen Verfahrens. 30 

In den Figuren bezeichnen gleiche Bezugszeichen gleiche oder funktionsgleiche Komponenten. 

Fig. 1 zeigt eine schematische Darstellung eines Robotersystemaufbaus zur Erlauterung einer ersten Ausfuhrungsform 
des erfindungsgemaBen Verfahrens. 

In Fig. 1 bezeichnet Bezugszeichen 10 einen an seinem Einsatzort fest montierten Roboter, 15 einen Roboterarm, 18 
eine (verdeckte) Roboterhand, 20 einen MaBkorper, R Referenzpunkte auf dem MaBkorper 20, 50 einen Lageermitt- 35 
lungssensor, welcher mit dem MeBpunkt 55 zusammenwirkt, K t und K 2 eine erste bzw. zweite externe Kamera, welche 
den MaBkorper in ihrem gemeinsamen Sichtbereich haben, 100 eine Robotersteuerung und 120 einen Hostrechner. Die 
Roboterhand 18 ist zusatzlich mit einem (nicht gezeigte) Werkzeug, z. B. einem MeBvideosensor, bestiickt. Mit diesem 
Systemaufbau ist man prinzipiell in der Lage, einerseits mit dem Roboter 10 Messungen vorzunehmen und andererseits 
die Position und Orientierung des MaBkorpers 20 zu bestimmen. 40 

In Form eine Steuerprogramms existiert in der Robotersteuerung ein Robotermodell in Form eines technischen bzw. 
physikalisch/mathematischen Algorithmus mit einem oder mehreren festgelegten Parametern, welches die theoretische 
raumliche Stellung des Roboters 10 in Abhangigkeit von einer oder mehreren SteuergroBen beschreibt. Als Parameter 
kommen bei spiels weise Linklangen, Achsenschiefstande, Nullpunktfehler, Gelenklose, Gelenkelastizitaten usw. in 
Frage. 45 

Mittels dieses Modells und einer entsprechend modifizierten Kincmatik ist der Roboter 10 in der Lage, kartesische Po- 
sitionen in seinem Arbeitsraum mit hoher Genauigkeit zu erreichen. 

Im folgenden wird naher erlautert, wie der oder die Parameter fur das Robotermodell festgelegt werden. Zum Zeit- 
punkt der Inbetriebnahme befindet sich der Roboter 10 in einer bestimmten kinematischen Konfiguration, die von den 
besagten intemen und externen EinfluBfaktoren abhangig ist. Diese Referenzkonfiguration wird iiber eine Referenzmes- 50 
sung festgehalten, indem der MaBkorper 20 an ausreichend vielen raumlichen Roboterstellungen (entsprechend Refe- 
renzpunkten aj mit i = 1 . . . n), welche durch die SteuergroBen bestimmt werden, durch die eine erste und zweite externe 
Kamera K t bzw. K 2 vermessen wird. Darauf erfolgt das Festlegen des oder der Parameter derart, daB das Robotermodell 
die raumliche Stellung des Roboters 10 an den Referenzpunkten in Abhangigkeit von der oder den SteuergroBen mit ei- 
ner bestimmten sehr hohen Genauigkeit beschreibt. Hoch bedeutet dabei, daB die Genauigkeit groBer ist als die aufgrund 55 
der kinematischen Veranderungen auftretenden Schwankungen. 

Andert sich nun die Referenzkonfiguration, d. h. treten kinematische Veranderungen des Systems auf, werden die Re- 
ferenzpunkte at nicht mehr mit der sehr hohen Genauigkeit anfahrbar sein, welche durch die Referenzmessungsparame- 
ter bestimmt ist, sondern es werden sich Abweichungen zwischen Soil- und Istwerten ergeben, welche mittels der beiden 
Kameras K t , K 2 und/oder dem Lagesensor 50 erfaBt werden. 60 

Aufgrund der jeweiligen Abweichung zwischen Sollwert Fi, und Istwert F*i wird eine Anpassung des oder der Para- 
meter des Robotermodells ausgelost, namlich bei dieser Ausfuhrungsform, wenn die erfaBte Abweichung einen vorbe- 
stimmten Wert uberschreitet. 

Diese Anpassung geschieht dadurch, daB ein jeweiliger Korrekturvektoren Tj zwischen der erfaBten tatsachlichen 
raumlichen Iststellung F*j des Roboters 10 und dem entsprechenden Referenzpunkt als Sollwert Fi eingefuhrt wird. Es 65 
gilt dabei die funktionelle Beziehung: 

T(M,aO • Tj = Fj (1) 
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wobei die Korrekturvektoren T £ den Fehler T(M, up 1 F { zwischen dem theoretischen SolbSrtT(M, ai ) und der Referenz- 
messung ?i beschreiben, wobei M das ursprungliche Computermodell ist. 

Der zcntrale Tcil der Anpassung besteht nun darin, daB urspriingliche Robotermodell M mil dem oder den ursprungli- 
cnen Parameter in em angepaBtes Robotermodell M* mit einem oder mehreren angepaBten Parametern umzuwandeln 

Diese Aufgabe fuhrt auf ein nicht-lineares Minimierungsproblem der Form: 

n 

I i |T(M*.a i ) - F A * T" 1 j 2 = min. (2) 

Die lasting dieses Minimierungsproblems erfolgt zweckmaBigerweise mittels der GauB-Newton-Melhode 
Durch die Emfuhrung der Korrekturvektoren gelingt es also, die Fehler zu quantisieren und zu kompensieren, welche 
auf kmemanschen Anderungen derReferenzkonfiguration beruhen. Dabei werden nicht die EinfluBfakLen, sond^rn de- 
Statkd unerheblich, daderRoboter 10 lediglich auf sein urspriingUches Verhalten zuriick- 

Das Steuern der theoretischen raumlichen Sollstellung des Roboters mit der Robotersteuerung (100) gemaB dem Ro- 

A^ g U erfSr h tSer ePaBten Parametern erf ° l8t dan ° erfa6ten A ^" 8 - — erneute 

hP ^n a l1" er ^ We i! terb - ildUng A e ■ ^ Ausflihrun g=fo«" wird nun eine robuste und reproduzierbare Prozedur angege- 
ben, durch die die Position und die OnenUemng eines MaBkorpers bzw. MeBwerkzeuges im kartesischen Raum holhg e- 

MeRmerlrmll ^ T ^ ^ tigt ^ den Me6wert - internes Koordinatensystem, in dem dL 

MeBmerkmale a prion bestimmt wurden, als EingangsgroBen. Im weiteren Verlauf der Prozedur entsteht eine Koordina- 

"a^en MeBwer^ eltk °° rdlnatens y stem zum MeBwerkzeugskoordinatensystem durch eine optimale Anpassung 

li.?^^ n-^ annten u b K t3n ™ ^MeBmerkmale untereinander wird die Gute derMeBdaten laufendeindeutig kontrol- 
Iiert, also nicht nur nach ihrer Plausibmtat, sondern genau quantisierbar. Somit kbnnen AusreiBer derMeBdaten konkret 
der gemessenen fctwerte der raumlichen Position des Roboters 10, eliminiert werden und verhindert werden, daB die irr- 
tumhcherweise eine Anpassung des oder der Modellparameter auslosen 

m^ inZe i nen der l MaSkor P er aus «»* «abilen Vorrichtung zum Anbringen von MeBmerkmalen (sog. Marker) 

H erbei sind verschiedene Vanationen von einer Metallplatte bis hin zu einzelnen Verstrebungen vorstellbar. Wichtie ist 
allem die geometnsche Invananz, also Stabilitat gegeniiber Verformungen 

de^MeiTr^^f natenSy / tem bzw u M^^^ugskoordinatensystem des MaBkorpers entsteht aus einer Messung 
Bed^™^nJ t^n Z a " SrelChend gr ° Ben Abstanden angebracht sind. Diese Messung erfolgt unter optimalen 
Bedingungen und hefert alle Markerpos.tionen im internen Koordinatensystem mit willkurlich definiertem Urspruns 

Eine Schatzung hefert die Position und Orientierung des MaBkorpers, der am Roboter 10 angebracht ist, bezuglich des 
Wel&oordinatensystems w.e z. B. erfaBt durch die externen Kameras K, und K 2 . Die extern erfaBten MeBwerte ySden 
TJ Z< P "Z Koo « iinaten * des intemen Koordinatensystems die Eingangsdaten fur diese Schat- 

zung. Man sucht nun eine Abbildung A bestehend aus einem TVanslationsanteil (a, b, c) und einem Rotationsanteil (<£ 3 

•** J * Urblld \ auf den fntsprechenden MeBwert yi abbildet. Dieser Ansatz laBt sich mit der Memodeder 
kleinsten Fehlerquadrate Idsen, namlich gemaB der Beziehung: 



I _ |A(a,b,c;a,p,y) Xi - Yi \* = m in. 



1=1 



(3) 



Der mitdere Fehler der Abbildung hefert dann ein MaB fur die gesuchte Gute 
f^sf^lt^trS^ 00 " dneS R ° bote ^— *«» -Eriauterung einer zweiten Ausfuhrungs- 

oinlh! 8 ' 2 ^n^" 611 ^ ZU den J^ reitS ein 8 efUhrten Bezugszeichen KC eine KamerasteuerungsAauswertung- 
einnchtung, 150 einen MeBvideosensor, 200 ein MeBobjekt in Form einer Fahrzeugkarosserie und PA eine MeBvideo- 
sensorsteuerungs/-auswertungeinrichtung. 

Der in Fig. 2 gezeigte Systemaufbau dient zur genauen Vermessung der Fahrzeugkarosserie 200 mit dem MeBvideo- 
sensor 150 unter Manipulation durch den Roboter 10. U WJBDVKW 
. Zunacbst ™ urd * ^ Robotermodell mit mehreren festgelegten Parametern, welches die theoretische raumliche Stel- 
lung des Roboters 10 in Abhangigkeit von einer oder mehreren SteuergrdBen beschreibt, vorgegeben. Es erfolgte dann 
ein Steuern der theoretischen raumlichen Sollstellung des Roboters mit der Robotersteuerung 100 gemaB diesem Robo- 
termodell und dabei eine Vermessung der Fahrzeugkarosserie 200 mit dem MeBvideosensor 150 

worfen" ^ aUfgebaUte MeBs y stem thermischen StreBfahrten mit einem Temperaturhub von 20°C unter- 

Es folgte ein Erfassen der tatsachhchen raumlichen Iststellung des Roboters 10 im Simulationsbetrieb durch die Sen- 

^p"." H Un i' n T deT * a ™l aS Ku Kz - We enVartet er 8 abt sich das Vorhandensein kinematischer Veranderungen 
als Folge der thermischen StreBfahrten. Es folgte eine erneute Vermessung der Fahrzeugkarosserie 200 mit dem MeBvi- 
deosensor 150 (unkompensierte Daten in Fig. 3). 

„nS R l8te t^uJ Anpasscn d( * P~ter Robotcnnodells zum Kompensieren der kinematischen \fcrandcrungen 
unter Berucksichtigung der erfaBten Abwe.chung und ein Steuern der theoretischen raumlichen Sollstellung des Robo- 
ters mit der Robotersteuerung gemaB dem Robotermodell mit dem oder den angepaBten Parametern und dabei eine er- 
neute Vermessung der Fahrzeugkarosserie 200 mit dem MeBvideosensor 150 (kompensierte Daten in Fig 3) 

Fig. 3 zeigt eine Darstellung der Haufigkeit von MeBabweichungen beim ublichen Verfahren im Vergleich zur zweiten 
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Ausfuhrungsform des erfincrangsgemaBen Verfahrens. 

Wie deutlich aus Fig. 3 erkennbar, zeigen die unkompensierten Daten eine Abweichung von bis zu etwa 0,390 mm ge- 
gcniibcr der crstcn Mcssung vor den thermischen StreBfahrten. Demgcgcnubcr zeigen die kompensiertcn Datcn lediglich 
eine Abweichung von bis zu etwa 0,125 mm gegenuber der ersten Messung vor den thermischen StreBfahrten. Die Kom- 
pensation schafft also eine Verbesserung um einen Faktor 3. 5 

Obwohl die vorliegende Erfindung vorstehend anhand bevorzugter Ausfiihrungsbeispiele beschrieben wurde, ist sie 
darauf nicht beschrankt, sondem auf vielialtige Art und Weisc modifizicrbar. 

Insbesondere sind genannten Anwendungen nur beispielhaft und beliebig verallgemeinerbar. Auch ist die Positionser- 
fassung nicht auf Kameras beschrankt. Der MaBkorper muB nicht ein selbstandiger Korper sein, sondern kann in den Ro- 
boter intcgriert sein. Auch die genannten Algorithmcn dienen nur Illustrationszwccken und konnen durch andere gecig- 10 
nete Optimierungsalgorithmen ersetzt werden. 

Bezugszeichenliste 

10 Roboter 15 
100 Robotersteuerung 
50 Sensor 

55 MeBpunkt fur Sensor 50 
15 Roboterarm 

18 Roboterhand 20 
20 MaBkorper 
Ki Kamera 1 
K 2 Kamera 2 

KC Kamerasteuerungs/-auswertungeinrichtung 

150 MeBvideosensor 25 

200 MeBobjekt, Fahrzeugkarosserie 

PA MeBvideosensorsteuerungsAauswertungeinrichtung 

R Referenzpunkt auf 20 

120 Hostrechner 
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1. Verfahren zum Erfassen und Kompensieren von kinematischen Veranderungen eines Roboters (10) aufgrund in- 
terner und/oder externer Einfliisse mit den Schritten: 

Bereitstellen eines Robotermodells in Form eines technischen Algorithmus mit einem oder mehreren festgelegten 35 
Parametern, welches die theoretische raumliche Stellung des Roboters (10) in Abhangigkeit von einer oder mehre- 
ren SteuergroBen beschreibt; 

Steuern der theoretischen raumlichen Sollstellung des Roboters mit einer Robotersteuerung (100) gemaB dem Ro- 
botemiodell; 

Erfassen der tatsachlichen raumlichen Iststellung des Roboters (10) im Betrieb durch eine Sensoreinrichtung (K t , 40 
K 2 ;50) 

Erfassen der kinematischen Veranderungen anhand der Abweichung der erfaBten tatsachlichen raumlichen Iststel- 
lung des Roboters (10) von der theoretischen raumlichen Sollstellung des Roboters (10); 

Anpassen des oder der Parameter des Robotermodells zum Kompensieren der kinematischen Veranderungen unter 
Beriicksichtigung der erfaBten Abweichung; und 45 
Steuern der theoretischen raumlichen Sollstellung des Roboters mit der Robotersteuerung (100) gemaB dem Robo- 
termodell mit dem oder den angepaBten Parametern. 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, daB das Anpassen des oder der Parameter des Robotermo- 
dells zur Kompensation der kinematischen Veranderungen unter Beriicksichtigung der erfaBten Abweichung er- 
folgt, wenn die erfaBte Abweichung einen vorbestimmten Wert uberschreitet. 50 

3. Verfahren nach Anspruch 1 oder 2, dadurch gekennzeichnet, daB das Bereitstellen eines Robotermodells in Form 
eines technischen Algorithmus mit einem oder mehreren festgelegten Parametern folgendermaBen erfolgt: 
Anbringen eines MaBkorpers (20) an der Roboterhand (18); 

Erfassen der tatsachlichen raumlichen Iststellung des MaBkorpers (20) durch die Sensoreinrichtung (K t , K 2 ; 50) an 
einer Vielzahl von durch den einen oder die mehreren SteuergroBen bestimmten Referenzpunkten; und 55 
Festlegen des oder der Parameter derart, daB das Robotermodell die raumliche Stellung des Roboters (10) an den 
Referenzpunkten in Abhangigkeit von der oder den SteuergroBen mit einer bestimmten Genauigkeit beschreibt. 

4. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB als die Sensoreinrichtung 
(Ki, K 2 ; 50) mindestens eine Kamera (Ki, K 2 ) verwendet wird, welche extern aufgestellt ist. 

5. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB als die Sensoreinrichtung 60 
(Ki, K 2 ; 50) mindestens ein Lageerfassungssensor (50) verwendet wird, welcher an der Roboterhand (18) ange- 
bracht ist. 

6. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB das Erfassen der kinemati- 
schen Veranderungen anhand der Abweichung der erfaBten tatsachlichen raumlichen Iststellung des Roboters (10) 
von der theoretischen raumlichen Sollstellung des Roboters (10) an den Referenzpunkten durchgefuhrt wird, indem 65 
ein jeweiliger Korrekturvektoren zwischen der erfaBten tatsachlichen raumlichen Iststellung des Roboters (10) und 
dem entsprechenden Referenzpunkt eingefuhrt wird. 

7. Verfahren nach einem der vorhergehenden Anspriiche, dadurch gekennzeichnet, daB die tatsachlichen raumliche 



5 



DE 198 26 395 A 1 

IststeUung des Roboters (10) im Betrieb durch die Sensoreinrichtung (K^ K 2 ; 50) mittels eines am Roboter (10) an- 
gebrachten MaBkorpers (20) ermittelt wird. 

8. Vcrfahren nach cincm dcr vorhergehcnden Anspriiche, dadurch gckennzcichnet, daB die Gute dcr im Betrieb 
durch die Sensoreinrichtung (K,, K 2 ; 50) erfaGten tatsachlichen raumlichen IststeUung des Roboters (10) ermittelt 
wird und das Anpassen da von abhangig gemacht wird. 

9. Verfahren nach Anspruch 8, dadurch gekennzeichnet, dafi das Ermitteln der Gute folgendermaBen erfolgf 
Bercitstellen eines MaBkorpers (20) mit Markern (R) ain Roboter (10); 

Festlegen eines inneren Koordinatensystems auf dem MaBkorper und der entsprechenden Koordinaten der Marker 

(R); 

Erfassen der Koordinaten der Marker (R) im Weltkoordinatensystem durch die wSensoreinrichtung (K b K 2 - 50)- op- 
timiertes Abbilden der Koordinaten der Marker (R) im inneren Koordinatensystems auf die Koordinaten der Marker 
(R) im Weltkoordinatensystem; und 

Ermitteln der Gute anhand des mittleren Fehlers der Abbildung. 

che Robotcrsteuerung (100) zurDurchfuhrung des Verfahrens nach mindestens einem der vorhergehenden Anspru- 
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The method involves using a robot (10) model with one or more parameters describing the theoretical 
spatial position of the robot depending on one or more control parameters. The parameters control the 
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